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RELATIVE  EQUILIBRIA  FOR  TWO  RIGID  BODIES 
CONNECTED  BY  A  BALL-IN-SOCKET  JOINT  * 


Li-Sheng  Wang 


P.S.  Krishnaprasad 


Electrical  Engineering  Department 

& 

Systems  Research  Center 
University  of  Maryland,  College  Park. 


ABSTRACT.  For  simple  mechanical  systems  with  symmetry,  a  variational 
principle  on  configuration  space  determines  relative  equilibria.  Here,  this 
principle  of  symmetric  criticality  is  applied  to  a  problem  of  coupled  rigid 
bodies.  Numerical  optimization  by  CONSOLE  (a  package  intended  origi¬ 
nally  for  optimization  based  control  system  design)  is  shown  to  be  an  effective 
technique  to  search  for  some  of  the  relative  equilibria. 


1  Introduction 

This  paper  is  part  of  an  ongoing  program  to  understand  the  dynamics  and  control  of 
multibody  systems  from  a  modern  point-of-view.  In  recent  years,  engineering  applications 
have  brought  into  focus,  questions  concerning  the  dynamics  of  systems  of  kinematically 

*  This  work  was  supported  in  part  by  the  AFOSR  University  Research  Initiative  Pro¬ 
gram  under  grant  AFOSR-  87-0073  and  by  the  National  Science  Foundation’s  Engineering 
Research  Centers  Program:  NSFD  CDR  8803012. 
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coupled  rigid  and  flexible  bodies.  In  [16],  these  are  referred  to  as  Eulerian  many-body 
problems  to  emphasize  the  role  of  Euler  forces  (or  frame  .forces)  in  determining  the  nature 
of  inter-body  interactions.  Eulerian  many-body  problems  arise  as  models  of  robotic 
manipulators,  high  speed  mechanical  machinery,  complex  spacecraft  with  articulated 
components,  space-based  sensors,  etc.  See  Wittenburg[31]  and  [5], [7]  for  treatments  of 
engineering  questions  and  formulation  of  equations  of  motion. 

In  recent  work  [3]  [4]  [12][15— 17]  [21][24— 27]  [29]  [30],  modern  geometric  techniques  have 
been  brought  to  bear  on  certain  classes  of  Eulerian  many-body  problems.  Included  among 
the  classes  of  problems  investigated  are  rigid  bodies  carrying  rotors,  planar  many-body 
systems,  three  dimensional  rigid  bodies  coupled  by  ball-in-socket  joints,  and  rigid  bodies 
with  flexible  attachments. 

In  the  present  paper,  we  investigate  the  structure  of  relative  equilibria  in  the 
dynamics  of  two  rigid  bodies  connected  by  a  ball-in-socket  joint.  We  follow  the  framework 
of  [12]  and  obtain  a  variational  characterization  of  relative  equilibria  using  a  theorem  of 
Smale.  A  key  geometric  condition  is  derived.  Numerical  search  for  extremal  critical  points 
is  carried  out  using  CONSOLE,  a  software  package  originally  intended  for  optimization- 
based  design. 

The  results  of  this  paper  can  be  considered  as  part  of  a  program  to  determine  the 
phase  portrait  of  coupled  rigid  body  systems.  In  his  ongoing  doctoral  dissertation  work 
at  Berkeley  (preliminary  results  presented  at  an  AMS  Summer  Research  Conference  on 
Control  Theory  and  Multibody  System  at  Bowdoin,  August  1988),  George  Patrick  has 
computed  relative  equilibria  for  certain  restricted  classes  of  coupled  rigid  body  problems. 
The  restrictions  involve  material  symmetry  and  the  present  paper  does  not  require  such 
symmetries.  Patrick’s  methods  involve  direct  symbolic  calculations  while  here  we  use  a 
variational  principle. 

The  model  problem  treated  in  this  paper  should  be  taken  as  illustrative  (partly 
inspired  by  early  examples  of  multibody  communication  satellite  design  [11][23]),  but  the 
techniques  apply  to  other  configurations  as  well.  Attitude  control  of  a  system  such  as  the 
one  in  this  paper  is  under  investigation  and  we  hope  to  report  on  this  in  a  later  paper. 
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2  Mechanical  Setting 

*n  this  section  we  describe  fk  i  • 

degre“  *  *  -  —  C0UP1,6  (  ”7“  —  -*-  -  •  <*- 


—  ui  ooay  2. 

Pl  :  orthon°ma  1  frame  on  body  1  w;,k  •  . 
j  ,  .  y  1  Wlth  origm  at  71/, 

■  ■  »  at>onal  coordinate  transformation  malrix  ^  ^ 


3 


T2 :  orthonomal  frame  on  body  2  with  origin  at  M2 . 

A2 :  rotational  coordinate  transformation  matrix  from  r2  to  To . 
di :  vector  from  the  joint  to  Mi  in  the  frame  Ti . 
c?2 :  vector  from  the  joint  to  M2  in  the  frame  r2 . 
rj :  vector  from  0  to  Mj  in  frame  To . 
r2  :  vector  from  0  to  M2  in  frame  To  • 

r0  :  vector  from  0  to  the  system  center  of  mass  in  frame  To  . 
m:  total  mass  (=  m\  +  m2). 

Q 1 :  vector  from  M\  to  a  point  of  body  1  in  the  frame  Ti . 
qi :  vector  from  0  to  the  same  point  of  body  1  as  Qi  above  in  the  frame  To . 
Q2 :  vector  from  M2  to  a  point  of  body  2  in  the  frame  T2 . 
q2 :  vector  from  O  to  the  same  point  of  body  2  as  Q2  above  in  the  frame  To . 
w :  vector  from  O  to  the  joint  in  the  frame  To . 

We  have  the  kinematic  relations. 


51  =  n  +  A1Q1.  (1) 

?2  =  r2  +  A2Q2.  (2) 

mr0  =  mjrx  +  m2r2.  (3) 

n  =  w  +  Aidi.  (4) 

r2  =  w  +  A2C?2-  (5) 


Also  we  know  that  A\  and  A2  belong  to  the  special  orthogonal  group  50(3) . 

Let  ni(-)  denote  the  mass  measure  of  body  1  in  the  frame  Ti  and  /z 2(-)  denote  the 
mass  measure  of  body  2  in  the  frame  T2  .  The  kinetic  energy  of  body  1  can  be  thus  written 
as 

K,  =  \  f  IIs.WOUVm.WO- 

“  J  Bi 

Expanding  the  above  by  using  (1),  (2)  and  the  formula  ||x||2  =  tr(xxt),  we  have  the  form 

IU  =  Y-IInll2  + 
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where  I\  is  the  coefficient  of  inertia  of  body  1,  defined  by 


h  -  /  QiQjdniiQi), 

J  B\ 

and  tr(-)  denotes  the  trace  of  a  matrix. 

The  kinetic  energy  of  body  2  has  a  similar  form.  We  thus  have  the  total  kinetic 
energy  expressed  as 

K  =  Kx  +  K2 

=  “||ri||2  +  itr(iiJiiif)  4-  ^|jr2||2  +  ^tr{A2hAl). 

By  (3)-(5),  we  may  write  the  total  kinetic  energy  in  terms  of  the  total  linear  momentum 
p  =  m*o  of  the  system. 

K  =  -  Avh ||2  +  ^||p||2. 

Here  e  =  is  the  reduced  mass.  Since  there  is  no  potential  assumed,  this  is  also  the 

Lagrangian  of  the  system. 

The  configuration  space  is  50(3)  X  50(3)  X  R3 .  The  system  is  invariant  under 
translation  of  the  inertial  reference  frame,  i.e.  we  have  a  symmetry  group  action  on  the 
configuration  space 

$:i23  x  (50(3)  x  50(3)  x  R 3)  -»  50(3)  x  50(3)  x  R 3 
(^5(^i5-42>r))  1-4  +  r). 

We  can  symplectically  reduce  the  system  by  R3  (see  Marsden  and  Weinstein [20], 
Abraham  and  Marsden[l])  which  in  turn  corresponds  to  jumping  to  the  center  of  mass 
frame.  This  is  also  done  in  [12]  and  for  planar  problem  in  [21]  [29]  [30].  After  this  reduction, 
the  reduced  Lagrangian  is 

L  =  -tr(AiIiA[)  +  - tr(A2hA2 )  +  -[[Aidi  —  1|2* 

which  is  a  function  on  T(50( 3)  x  50(3)). 

Although  the  mechanical  system  considered  here  is  exactly  the  same  as  in  [12], 
the  Lagrangian  is  expressed  in  terms  of  coefficients  of  inertia  referred  to  different  body 
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frames  than  the  one  they  use.  Ours  is  based  on  the  body  frames  affixed  to  centers  of 
mass.  By  applying  the  formula  for  change  of  coefficient  of  inertia  by  translation,  one 
checks  that  the  results  are  the  same.  In  the  next  section,  we  outline  the  general  theory  of 
simple  mechanical  system  with  symmetry  to  the  point  of  characterizing  relative  equilibria. 
Standard  references  for  the  next  section  are  Smale[28]  and  Abraham  and  Marsden[l].  See 
also  Libermann  and  Marle[18],  Arnold[2],  and  Guillemin  and  Stemberg[13]. 


3  Mechanical  Systems  with  Symmetry 

Let  ( Q ,  <C  •,  •  ^>)  be  a  Riemannian  manifold  with  the  Riemannian  metric  -C  •,  • 

Let  G  be  a  Lie  group.  $  :G  x  Q  -+  Q  is  a  group  action  on  the  manifold  Q  that  leaves  the 
Riemannian  metric  invariant.  Let  V:Q  — ►  R  be  a  G -invariant  function  on  the  manifold, 
i.e. 

V(*a(x))  =  V(x)  VgeG, 
where  $g:  M  -+  M  is  defined  by 


Let  r:  TQ  —*  Q  be  the  canonical  projection.  We  now  define  a  Lagrangian  L:  TQ  — ►  R  to 
be,  for  vx  €  TQ  with  t(vx )  =  x, 

L(vs)  =  |  <  vx,vx  >  -  V(x). 

It  follows  that  the  Lagrangian  is  G -invariant  and  hyperregular.  We  thus  have  the 
corresponding  invertible  Legendre  transformation  FL:TQ  — »  T*Q  given  by 

FL(vx)(wx)  =  <  vx,wx  »  . 

Let  lo o  be  the  canonical  symplectic  two  form  on  T*Q ,  and  define 

u)L  —  (FL)*u>q. 
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Then  it  is  easy  to  see  that  u>£,  is  a  symplectic  form  on  TQ.  The  action  A:TQ  — *  R  is 
now 

A(vx)  =  <  vx,vx  > 

and  the  energy  E  =  A  —  L  can  be  found  subsequently.  Thus  we  have  two  equivalent 
hamiltonian  systems  (TQ,ul,E)  and  ( T*Q,u0,H  =  E  o  FL~l).  These  are  simple 
mechanical  systems  with  symmetry  in  the  sense  of  Smale[28][l].  The  hamiltonian  function 
on  T*Q  can  be  written  as  (for  ax  6  T*Q  with  r*(ar)  =  x  where  r*  is  the  canonical 
projection  on  T*Q ), 

H(ax)  =  |  <  FL-\ax\FL-\ax)  >  +  V(x). 

We  define  an  inner  product  on  T*Q  by 

<  <*x,0x  >T-Q  =  <  FL~l(ctx),  FL'1  (0X)  >  . 

Then  we  may  write 

H(ax)  =  ^  <  &x,oix  >t*Q  +  V(x). 

Let  O'  denote  the  Lie  algebra  of  G  and  is  the  dual  of  the  Lie  algebra.  By  the  Corollary 
4.2.11  in  [1],  we  know  that  the  lifted  action 

§r:Cxr«-,pg 

is  symplectic  and  has  an  Ad*  -equi^ variant  momentum  mapping  given  by  J:T*Q  —*  S'* , 

J(a*)(0  =  (£q(x))  (6) 

where  £  €  $  and  £q  is  the  associated  infinitesimal  generator  of  $  on  Q. 

Now  we  introduce  the  notion  of  relative  equilibrium  in  a  general  setting.  Assume  G 
acts  on  a  symplectic  manifold  (P,  u>)  freely  and  properly.  Then  the  quotient  space  P/ G  is 
a  smooth  manifold  with  an  induced  Poisson  structure.  For  any  G -invariant  hamiltonian 
function  H  on  P,  we  find  the  induced  function  H:PfG  ->  R  in  the  following  way.  Letting 
f  be  the  projection  from  P  to  P/G ,  we  have 

H  o  f(x)  =  H(x). 
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Since  H  is  G -invariant,  H  is  well-defined.  The  quotient  P/G  carries  an  induced  Poisson 
structure[19].  Given  f,g€z  C°°(P/G) ,  the  induced  Poisson  bracket  of  /  and  g  is 

{f,9}°f=  {/of,ffof}0. 

where  {,  }o  is  the  standard  Poisson  structure  on  the  symplectic  manifold  (P,  w). 

With  this  induced  Poisson  structure  and  the  induced  hamiltonian  function,  we  define 
the  projected  hamiltonian  vector  field  Xfj  on  P/G.  For  any  /  e  C°°(P/G), 

XhU]  =  {/,£}• 

Definition  (Relative  Equilibrium) 

zt  6  P  is  a  relative  equilibrium  for  Xu  if 

Xfj  (?(ze))  =  0. 

Asstune  there  is  an  Ad* -equi variant  momentum  mapping  J  on  P.  Then  we  have  the 
following  characterization  of  a  relative  equilibrium. 

Theorem  (Relative  Equilibrium) 

ze  6  P  is  a  relative  equilibrium  for  Xu  iff  there  exists  a  f  €  9?  such  that  ze  is  a 
critical  point  of 

Ht  =  H-<J,t>, 

where  <  J,£  >:  P  —*  R  is  given  by  x 
Proof 

Let  Ft  :  P  — »  P  be  the  flow  of  H  on  P .  We  have  the  induced  flow  Ft  :  P/G  —*  P/G 
satisfying 

Ft  o  t  =  fo  Pt. 


Thus  2e  is  a  relative  equilibrium  iff  Xh(t{z<))  =  0  iff 


That  is 


f  oFt(ze)  =  f(ze).  Vt 

Thus,  for  all  t ,  F t(ze)  must  belong  to  the  same  orbit.  And  there  exists  a  one-parameter 
subgroup  g(t )  £  G  such  that 

Ft(ze)  =  $s(t)(2e). 

By  the  one-to-one  correspondence  between  one-parameter  subgroups  in  G  and  its  Lie 
algebra,  we  know  that  there  exists  a  £  €  $  such  that 


Differentiate  both  sides  with  respect  to  t  and  set  t  =  0 ,  we  get 

-Xi/(2e)  =  Zp(zt). 

On  the  other  hand,  by  the  definition  of  a  momentum  mapping,  X<j^>  =  .  Thus 

XH(ze)  =  X<  j,(>(ze), 

which  implies 

XH-<j,(>(ze)  =  0. 

By  the  nondegeneracy  of  u ,  we  have 

d(H-<J,t>)(ze)  =  0, 


i.e.  zt  is  a  critical  point  of  =  H —  <l(>- 

Conversely,  if  ze  is  a  critical  point  of  ,  also  from  the  nondegeneracy  of  u 

XH-<J,(>(ze)  =  0. 


which  implies 


Thus,  by  uniqueness  of  the  integral  curve, 

Fti^Ze')  =  $expt£(ze'). 
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It  follows  that  zt  is  a  relative  equilibrium  for  Xh  from  the  previous  arguments. 

QED  | 

Remark  1. 

This  theorem  can  be  considered  a  corollary  to  the  Souriau-Smale-Robbin  Theorem 
(see  Abraham  and  Marsden[l]).  It  is  also  discussed  in  [27]. 

Remark  2. 

We  note  that  if  a  point  zt  is  a  relative  equilibrium  point,  the  motion  FxH{ze) 
is  a  stationary  motion,  i.e.  it  corresponds  to  a  group  orbit.  If  for  instance  the  group 
G  =  50(3),  this  would  imply  that  FxH(ze )  corresponds  to  a  uniform  rotation  about  a 
fixed  axis  £  in  space. 

We  now  apply  this  theorem  to  the  setting  of  simple  mechanical  systems  with 
symmetry  discussed  before.  By  the  hyperregularity  of  FL ,  for  any  ax  £  T*Q,  there 
is  an  element  vx  G  TQ  such  that  ax  —  FL(vx)  and 

ax(w)  =<.vx,w'>  Vw£TxQ. 

Thus  the  momentum  mapping,  which  is  given  by  (6),  can  be  written  as 

Uq(x))  —  <■  FL~1{oix),£q{x)  >  . 

Defining  B^(x)  —  FL(£q(x)),  we  have 

<  J,£  >  (at)  =<  ax,Bs(x)  >t*q  ■ 

We  can  now  write 

H^(ax)  —  i  <  ax,ax  >t*q  +V(z)-  <  aXiB^(x)  >t*q  • 

By  determining  the  norm  on  T*Q  through  the  inner  product  and  completion  of  squares, 
we  may  express  iff  as 

=  ~li«x  -  #f(r)||2  +  V(x)  ~\<  Bi{x),Bt{x)  >t*q  • 
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By  the  above  theorem,  computing  the  relative  equilibria  is  equivalent  to  finding  critical 
points  of  H{.  Letting  ott  =  (x,p)  we  have 

=  \\\ p-  £«(*)ll2  +  ^(*)  -  \  <  Biix\Biix)  >t*q  • 

It  is  then  easy  to  check  that  the  necessary  conditions  for  (xe,pe)  to  be  a  critical  point  of 
H(  are 

Pe  =  B((xe)  (7) 

and 

d,.{V(x)  -  i  <  B((x),B'( x)  >t*q]  =  0 

We  summarize  the  algorithm  ( principle  of  symmetric  criticality)  to  find  relative  equilibria. 
Algorithm 
0.  Pick  £  €  S. 

1.  Search  for  the  critical  points  xe  of  the  function 

Vf.Q  R 

V«(*)  -  V(x)  -  i  «  («(*),  fo(*)  > 

2.  Put  xt  in  (7)  to  find  the  corresponding  pe  =  B^(xe). 

We  note  that  the  computation  in  step  1  is  fully  on  the  configuration  space. 
Remark  3.  (Historical) 

The  principle  of  symmetric  criticality  as  stated  here  appears  as  Theorem  1.1  in  Part 
II  of  Smale[28].  Smale  also  notes  that  special  versions  have  been  known  earlier,  e.g.  in  the 
study  of  symmetric  geodesics.  See  also  pp.  355  of  [1],  Theorem  16.7  in  Hermann[14],  and 
Palais[22]. 

Remark  4.  (Symmetry  of  ) 

It  should  be  noted,  for  a  given  £  e  S,  has  the  symmetry, 

v«(*i(*))  =  v€(*)f 

for  all  g  €  (?$  =  {g  €  G\Adg(()  =  £},  the  stabilizer  of  £.  Thus  induces  a  function  V<r 
such  that  the  diagram  in  Fig.  2  commutes. 
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Figure  2  Symmetry  of 

Typically,  is  a  Morse  function  on  Q/G^  and  ^^(xe)  is  a  nondegenerate  critical 
manifold  in  the  sense  of  Bott[6],  if  xt ■  is  a  critical  point  of  Vjr . 

Example 

One  application  of  the  principle  here  is  to  find  the  relative  equilibria  of  the  planar 
three-body  system  discussed  in  [29]  [30].  If  we  plot  the  function  (for  particular  kinematic 
parameters)  on  the  joint  space,  we  get  the  picture  in  Fig.  3,  from  which  the  fundamental 
equilibria  defined  in  [29]  [30]  can  be  easily  seen.  These  are  the  relative  (joint)  configurations 
(0,0),  (0,  tt)  ,  (tt,0),  (7T,7r). 


4  Relative  Equilibria  for  Coupled  Rigid  Bodies 

For  the  mechanical  system  described  in  section  2,  the  Riemannian  metric  on 
■'  T(50( 3)  x  50(3))  is  given  by  the  (symplectically)  reduced  Lagrangian  as 

<  (Wu  W2),(Wi,  W2)  »=  HWxhW?)  +  ir{W2I2W?)  +  e\\Wx<h  -  W2d2\\2. 

where  (TVi,  W2)  belongs  to  T(50( 3)  x  50(3)).  We  know  that  every  element  in  T(50( 3)  x 
50(3))  can  be  represented  as 

T(50(3)  x  50(3))  =  {(Ai,A2,wiAi,w2A2):Ai,A2  €  SO(3),wi,w2  €  -R3}> 

where  " :  Rz  ->  so(3)  is  the  one-to-one  map  from  R3  to  the  skew-symmetric  matrices, 

(0  -ti’3  w2 

U>3  0  —  W\ 

—w2  w  i  0 
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A 

Figure  3  Function  for  the  planar  3-body  problem 


In  terms  of  t«i ,  w2 ,  we  have 

•C  (Wi,  Wa),(Wi,  W2)  >=  tr(wiAiIiA[w'[)  +  tr(w2A2l2-AZwl)  +  t\\wiAidi-w2A2d2\\'2. 
It  is  a  straightforward  calculation  to  show  that 

ir(uiIuT)  =<  u>,  I  u>>e 

O 

where  I  is  a  coefficient  of  inertia  tensor  and  I  is  the  associated  moment  of  inertia 
tensor  and  <}>e  is  the  Euclidean  inner  product.  Upon  further  simplifications  and 
rearrangements,  we  get 

=  ((AlWl)T  (Alw2)T)(]'r 

where 

0  Arp  a 

J\  =  1 1  +  fdj  d\ 

O  Arp  A 

J2  —  I 2  -J-  (d 2  d2 

A  rp  a 

J\2  —  edjv4j  A2d2 
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The  group  action  to  consider  is  defined  on  50( 3)  X  50(3) ,  the  configuration  space,  relative 
to  an  observer  at  the  system  center  of  mass.  The  diagonal  action  of  the  group  G  =  50(3) 
is  given  by 

<b:Gx  (50(3)  X  50(3))  -  50(3)  x  50(3) 
(Ri(AuA2))^(RA1,RA2). 

Letting  f  €  3 ,  the  corresponding  infinitesimal  generator  can  be  found  as 

£q(Ai,A2)  =  j-  (expt()(AuA2) 
dt  t=o 

__  £ 

~  dt  <- o 

«(|Ai,|Aa). 

Since  here  the  potential  energy  V  is  identically  0 ,  the  function  VJt  is 

V((AuA2)  =  -\((Anf  (40T)(/l 

It  is  clear  that  is  invariant  under  G$  —  {R  €  G:  R£  =  £}  which  is  isomorphic  to  51 . 

By  the  compactness  of  50(3)  X  50(3)  we  know  that  for  each  (,  has  critical 
points.  We  need  to  find  the  conditions  on  A\ ,  A2  so  that  the  gradient  of  with  respect 
to  A\ ,  A2  is  0 .  Equivalently  one  can  check  the  vanishing  of  the  differential  dV^  on  the 
space  T(50(3)x50(3)). 

Given  f  :  M  —*  R  a  smooth  fimction  on  a  smooth  manifold  M,  vx  6  TXM  which 
generates  a  curve  <j> :  R  —+  M  with  <^(0)  =  x ,  the  differential  df  at  x  is  defined  by 

<*/«(».)  s  4  fmr 

ai  t—O 

Let  W  €  T(50(3)  x  50(3)), 

W  =  (A1,A2,w1Auw2A2). 

The  curve  in  50(3)  x  50(3)  generated  by  W  is  {e**'Au  e**aA2).  Thus  we  have  the 
formula 

dV((Ai,A,yW)  =  4  n(e"i’M1,e“M2), 

°l  t—O 


((expt()Ai ,  (exp  t()A2^ 
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Explicitly,  we  get  the  following  final  form  (here  A  =  Aj  A2 ), 

dVt(Ai,Ai)(W)  =  <  wutAiJiAft  >E  +  <  w2i£ A2hA2i  >E 

+  e  <  wi,£AidiAd2A%£  >E  +e  <  w2,£A2d2AT d\Al £  >E 
+  e  <  A2d2A2i  >E  +e  <  'w2,A2d2( A\d\A^i  >E 

Thus  we  know  that  the  necessary  conditions  for  a  critical  point  of  are 

^AiJiA'i  ^  +  c^Aidi AdiA^ £  -f  A2d2A’2  ^  —  0, 

£A2J2AjZ  +  e£A2d2AT d\A[ £  +  tA2d2£  A\d\A[^  =  0. 

Now  if  we  define  =  Aj(,  and  fl2  =  ■d.J'C,  we  get  the  conditions  (in  terms  of  cross 
products  in  Rz  ) 


ill  x  Jiih  +  x  (fti  x  A(d2  x  fl2))  =  0,  (8) 

il2  x  J2il2  +  ed2  x  (ft2  x  AT(di  x  fix))  =  0,  (9) 


which  are  exactly  the  conditions  found  by  Poisson  reduction  in  [unpublished  notes 
of  P.S.  Krishnaprasad]. 

In  step  2  of  the  algorithm  of  section  3,  we  put  in  the  A\ ,  A2  found  by  solving  the 
above  conditions  into 

P  =  B((Ai,A2) 

—  FL(Zq(Ai,A2))  . 

Let  p  €  T*(50(3)  x  50(3))  be  represented  as 

p  =  (aiAi,a2A2). 

We  find  that  c*x ,  a2  can  be  expressed  as 

ox  =  AiJiHi  -f-  t(A\d\  x  A2{d2  x  fi2)) , 

Oi2  =  A2J2il2  +  £ (A2d2  x  A\(di  x  fli))  • 
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Also  we  know  that  the  relation  between  fli  and  ^2  is 


Hi  —  j4H2, 


If  we  now  let  si  =  A\d\ ,  s2  =  A2<i2 ,  from  (8),  we  get 

Aji  x  +  eAfsi  x  ( A x  A(A^s2  x  A^O)  =  0, 

which  implies 

e  X  Ai  JiAfe  +  Ml  X  (£  X  (s2  x  0)  =  0.  (10) 

Taking  the  inner  product  of  (10)  with  £,  we  obtain  a  key  necessary  condition  for  a  relative 
equilibrium 

£ • (ai  x  s2)  =  0.  (11) 


We  note  that  £  is  the  axis  of  rotation  of  the  whole  body,  si ,  s2  are  the  spatial  vectors  from 
joint  to  body  1  and  2,  respectively.  From  (11),  we  conclude  that,  at  relative  equilibria,  f , 
si ,  «2  must  lie  on  the  same  plane,  no  matter  what  the  inertias  are. 


5  Numerical  Method 

Although  we  can  get  the  same  critical  conditions  (8)  (9)  by  other  methods,  the 
principle  of  symmetric  criticality  provides  more  information.  Notice  that  in  the  first  step  of 
the  algorithm  in  Section  2,  we  simply  try  to  find  the  critical  points  of  on  50(3)  x  50(3) 
without  any  additional  constraint.  Thus  one  has  an  associated  unconstrained  optimization 
problem.  Numerical  optimization  schemes  can  be  used  to  find  extremal  relative  equilibria. 
This  issue  is  discussed  in  this  section. 

By  the  symmetry  of  the  system,  we  know  that  the  function  is  invariant  in  the 
direction  tangent  to  the  orbit  of  G$ .  Thus  in  the  search  for  critical  points,  we  should  avoid 
these  directions.  It  turns  out  that  the  usual  gradient-type  method  is  a  good  choice.  Here, 
we  use  an  optimization  package  named  CONSOLE  which  was  developed  at  the  University 
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of  Maryland[8].  The  current  version  of  CONSOLE  basically  uses  the  steepest  descent 
method  and  is  thus  applicable  to  our  circumstances. 


In  formulating  the  optimization  problem,  in  order  to  avoid  other  constraints  arising 
from  the  restrictions  on  SO(3),  e.g.  X?  A  —  Identity ,  we  use  Cayley’s  parametrization. 
That  is,  any  element  A  €  50(3)  can  be  represented  by 


A  = 


1 

1  +  aj  +  a\  +  a% 


Il  +  a\-al~a\ 
j  2(aia2  +  a3) 

\  2{a\az  —  a2) 


2(aia2  -  a3) 

1  —  aj  +  a|  —  a| 
2(a2a3  +  a\ 


2(aia3  +  a2) 
2(a2o3  -  ai ) 


1  —  aj 


a 


+  «3), 


where  ai,a2,a3  €  R.  The  problem  can  now  be  written  as 

extremize  V^(Ai,A2) 

{<llj  <22)  03  1 

J 

where  (fli,a2,a3),  (&i,62,63)  are  the  parameters  for  Ai ,  A2 ,  respectively. 

The  CAD  package  CONSOLE  is  composed  of  two  main  programs:  CONVERT, 
SOLVE.  CONVERT  reads  a  problem  description  file  which  describes  the  optimization 


problem  to  be  solved.  SOLVE  then  performs  the  optimization  process  with  the  interaction 
of  user  and/or  some  simulator.  For  more  details,  see  Fan  et  el.  [9]  [10].  The  problem 
description  file  for  our  problem  is  easily  formulated  as  follows. 


design_parameter  al  init»0 
design.parameter  a2  init«0 
design.parameter  a3  init=0 

design.parameter  bl  init=0 
design_parameter  b2  init«0 
design_parameter  b3  init»l 

objective  "V-xi" 
minimize  { 

import  al,  a2,  a3; 
import  bl,  b2,  b3; 

double  cost(); 

return  cost(  al,  a2,  a3,  bl,  b2,  b3  ); 

good_valuess0 

bad_value=100 


where  the  subroutine  cost()  reads  a  system  description  file  containing  the  information  of 
hi  h,  d\ ,  d2 ,  £,  mi,  m2  and  then  returns  the  value  of  the  function  Vje.  By  choosing 
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different  moments  of  inertia  and  initial  structure,  we  can  perform  the  optimization.  In 
the  process,  one  thing  we  learned  is  that  if  the  augmented  inertia  is  diagonal,  the  rate  of 
convergence  is  faster.  Thus  preliminary  diagonalizations  should  be  performed  to  get  speed 


up. 

In  the  particular  case  that 


mi  =  3.0 
m2  =  2.0 
dx  =  (0  0  1) 
d2  =  (-1  1  1) 

€-(001) 

/  2  0  0\ 
h  =  0  3  0  ) 

\0  0  4 ) 

/  3  0  0\ 

/2  =  0  4  0  , 

\0  0  5  / 

the  relative  equilibrium  we  found  by  numerical  methods  was 

/  0.0  -0.939  0.344  \ 

Ax  =  0.0  -0.344  -0.939 

\1.0  0.0  0.0  / 

/  0.007  0.350  -0.937  \ 

A2  =  -0.528  0.796  0.294 

\  0.849  0.493  0.191  ) 

si  =  (0.344  -  0.939  0.0) 

52  =  (-0.593  1.618  -  0.165) 

Oi  =  (1.0  0.0  0.0) 

=  (0.849  0.493  0.191) 
ax  =  (0.0  0.0  10.269) 
c*2  =  (-0.004  0.007  14.321). 

Several  relative  equilibria  corresponding  to  different  choices  of  parameters  are  shown  in 
Fig.  4.  Case  1  in  that  figure  corresponds  to  the  above  numerical  result. 
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Figure  4  Relative  Equilibria 


Note  that  in  all  cases,  either  si  =  A\d\ ,  $2  =  ^2^2  are  on  a  straight  Une  or  they 
and  £  are  on  one  plane.  It  matches  the  conclusion  we  made  at  the  end  of  section  4. 


6  Conclusion 

We  have  shown  how  to  determine  relative  equilibria  by  numerical  search.  A  key 
geometric  condition  (Equation  11)  appears  as  a  consequence  of  the  variational  formulation. 
Evnamic  simulations  are  being  carried  out  to  determine  further  details  of  the  phase* 
portrait. 
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